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Abstract —Two different aspects of formation control of multi¬ 
ple agents subjected to linear transformation have been addressed 
in this paper. We consider a set of complex single integrator 
systems so that the dimension of the system reduces to half 
as opposed to the vector representation in Cartesian coordinate 
system. We first design a stable formation controller in an attempt 
to solve the formation control turned to stabilization problem 
and then find a collision avoidance controller in the transformed 
domain, respectively. Different linear transformations are used 
to facilitate the formation control task in a different way. For 
example Jacobi transformation is used to separate the shape 
control and trajectory control. The inverse of the transformation 
must have nonzero eigenvalues with both positive and negative 
real parts which may lead the system to instability. If the inverse 
of the transformation appears in closed loop then a diagonal 
stabilizing matrix is required to reassign the eigenvalues of the 
inverse of transformation in the right half of complex plane. The 
algorithm to find such stabilizing matrix is provided. We then 
define a matrix of potential in the actual domain which is the 
stepping stone to find a matrix of potential in the transformed 
domain. Thus collision avoidance controller can be designed 
directly in the transformed domain. The mathematical proof 
is given that both the actual and transformed system behaves 
identically. Simulation results are provided to support our claim. 

I. Introduction 

The study of the collective behaviour of birds, animals, 
fishes, etc. has not only drawn the attention of biologists, 
but also of computer scientists and roboticists. Thus several 
methods of cooperative control Q of multi-agent system have 
evolved, where a single robot is not sufficient to accomplish 
the given task, like navigation and foraging of unknown 
territory. These methods can broadly be categorized as the 
behaviour based approach ( Q, Q, Q), leader follower based 
approach ( 0, 0), virtual structure based approach ( J0, 
0, 0, pb)), artificial potential based navigation ( | |TT[ , fl^ , 

1 1^), graph theoretic method ( 0^ m))’ Ibrmation shape 
control ( IB), 10, 0). These strategies can either be 
centralized or decentralized depending upon the control laws 
designed. 

In this paper we part the formation control problem for a 
set of complex single integrators subjected to real linear 
transformation into two sub-problems: stabilization and inter 
robot collision avoidance. Complex representation reduces the 
dimension of the system to half as opposed to Cartesian vector 
representation. The use of linear transformation to solicit 


formation control problems can be found in ]B) , flS) . An 
example of such real linear transformation can be Centroid 
based Transformation (CBT). Jacobi transformation 0 is 
one such CBT used to separate shape control and tracking of 
centroid. We are more interested to find a stabilizing matrix if 
the transformation appears in the closed loop system than to 
use the advantages of the transformation. Therefore we first 
rewrite the augmented system such that the inverse of linear 
transformation appears in the closed loop system. The eigen¬ 
values of the inverse of the transformation must be nonzero 
but may have both positive and negative real parts. This may 
lead to instability of the combined system. Using a diagonal 
stabilizing matrix [?] we reassign the eigenvalues of the 
inverse of transformation in the right half of the complex plane 
so that the closed loop system becomes stable. We propose 
in this paper an alternative but systematic design procedure 
on multiplicative inverse eigenvalue problems (MIEPs) 0 
and |20) . That is we update the inverse of the real CBT and 
reassign the eigenvalues by pre-multiplying a real diagonal 
matrix, called a stabilizing matrix [?]. Sufficient conditions 
for the existence of a real stabilizing matrix are developed 
and algorithms are provided to find it. 

The use of potential functions for navigation is not new to 
formation control community. One of the first works ap¬ 
plying artificial potentials to agent coordination is found in 
0, where they consider a distributed-control approach of 
groups of robots, called the social potential fields method. 
The construction of artificial navigation functions along with 
collision avoidance is addressed in 0- Two types of colli¬ 
sion avoidance functions are there: obstacle avoidance |22 , 
10, |24l and inter robot collision avoidance 0, |0, | ]_3 , 
0, 0, 0. Obstacle avoidance functions are used to 
avoid static or moving obstacles, whereas inter robot collision 
functions are used to avoid collision among the robots while 
moving in formation. The diagrams of the negative gradient 
of collision avoidance functions are given in |24| , |T3) . These 
functions are all defined in the Cartesian Coordinate system 
based either on the distance between a robot and obstacles 
or the distance between a robot and its neighbours. The total 
potential of a robot is the summation of all the potentials due to 
the neighbouring robots. The potential term can be written in 
matrix form post multiplied with the states for the augmented 
system. We call this the matrix of potential. 




In this paper, we introduce a matrix of potential in transformed 
domain for a set of single integrator systems subjected to a 
linear transformation to study collision avoidance in formation 
control problem. Linear transformations to solicit formation 
control problem can be found in HD and |T8). The use 
of potential function based controller in |15| and m may 
have restricted the usefulness of the transformation in the 
separation of shape control and trajectory tracking of the 
centroid. Whereas potential function based controller is used 
in m, but not in the transformed domain. This leads to 
the query what would be the collision avoidance controller 
in the transformed domain so that the stability analysis can be 
carried out entirely in the transformed domain. To address this 
issue, we have dehned a matrix of potential for the augmented 
system in the Cartesian domain, which when post multiplied 
with states gives total effect of potential on the kinematics of 
a specific state. Then by using a linear transformation matrix 
we apply similarity transformation on the matrix of potential 
in Cartesian coordinate only to get the matrix of potential in 
the transformed domain. This matrix in hand, is then used to 
design the collision avoidance controller in the transformed 
domain. We have mathematically proved that the matrices of 
potential affect both the system in the actual and transformed 
domain in the same manner. 

Notations: K denotes the set of real numbers and denotes 
the identity matrix of order n. All elements of given matrices 
are multiplied with I 2 and therefore is omitted for brevity. 

mds 

December 27, 2012 


II. Priliminaries 

A. Shape spaces 

Let Qi = G = l,...,n denote the positions 

of a system of n particles with respect to fixed inertial 
coordinate frame of reference. The positions of the same 
particles is denoted by Zi = Xi + tyi G C,i = in 

complex coordinate system. Let there be another complex 
coordinate system ^ — 1, where, 

~ C C are shape vectors, where pij G K, 

and are not all Os, and = JJlLi G C denotes the centroid 
of all positions. Then we define a real linear mapping for real 
systems K 2 nx 2 n : R"- K’T’ as 

T:q^^ ( 1 ) 

And we also dehne a real linear mapping for complex systems 


T:z^^ ( 2 ) 

Specific applications of such mapping T, x —>• 

can be found in | |T^ and i fTs) . For brevity we call the 
mapping T as Centroid based transformation (CBT). One 
example of CBT is Jacobi transformation to get Jacobi vectors 
for Jacobi shape space US- We will consider Jacobi vectors 
as an example, to deduce our results in this article, though the 
results will comply similarly with other CBTs flS). We give 


more stress to defining a new coordinate system to analyse the 
behaviour of the particles with respect to that reference frame, 
rather than investigating an interaction topology (communica¬ 
tion among the agents), as in Graph theory ||T|, with respect 
to specific coordinate system (Cartesian coordinate or Inertial 
frame). 

Definition 1. Let there be a real linear transformation 

]j2«x2n . ^2n ]^2n aS 

T:x^i (3) 

and a complex weight matrix W = diag{wi\,i = l,...,n 
with Wi = Oi + biL, ai,bi G ffi. Then a complex linear 
transformation c 2 nx 2 Tt . |^ 2 n |^ 2 n defined as 

$ : a; ^ ^ (4) 

where ^ = WT. 


III. Main Result 

We consider a group of n agents in the plane labelled 
l,...,n. The positions of the n agents are denoted by 
xi,...,Xn G i.e.,a;i = [pxi,Pyi]'^- Then the positions 
of the same agents can be described in complex plane as 
Zi = Pxi + tpyi G C, i = Suppose that each agent 

is governed by a single-integrator kinematics 

Zi = Ufi -I- Uat (5) 

where Zi G C represents the position of agent in the 
complex plane and Ufi = Ufxi + tufyi G C and Uai = 
Uaxi + tUayi € C are the formation controller and the 
collision avoidance controller respectively. Then the combined 
dynamics of Q can be written as 

Z = Uf +Ua ( 6 ) 

where z = [zi, ..., Zn]'^ G C", Uf = [ufi ,..., € C” and 

Ua = [uai, ■■■,Uan]'^ G C". Consider that the system is 
driven by the following control laws 

Uf = -K,Ze + Zd 
Ua=-V fz 

where G C"^” is the controller gain and Ze = z—Zd G C”, 
with Zd — Zd2\ G C , and Zdi — Zdxi “f tXdyi G 

C is the desired trajectory given to the agent to follow. 
Define v/i = fij G C with v/ii G C is the 

gradient of any distance based potential function defined by 
fij = f{zi,Zj) with respect to agent. Zi and zj are the 

positions of and agents. Let Zg = [zgi, ..., Zen]^ G C" 

and v/z = [v/i) V/n]^ G C". Then the overall closed 

loop dynamics of n agents can be written as 

Ze = -AT^Ze - V/z (8) 

Applying transformation of [] we get 

i - V/€ (9) 

where and = «> V fx- Let K, = 

with D = diag{di, ...,dn} G C"^” be a diagonal stabilizing 



matrix []. Then ^ and the system can be 

rewritten as 

- V/j (10) 

Next we define the tracking with formation problem. 

Definition 2. The system asymptotically leads to a 

tracking in formation as limt_>oo = 0. 

Theorem 1. The system ( |10| l asymptotically leads to a track¬ 
ing in formation as limi_>,oo ^6 = 0;/ and only if both 
= 0 and v/f = 0 as t ^ oo. 

Proof: (Sufficiency). It is clear that if both = 0 

and v/^ = 0 as f —>■ oo, then limt_>.oo Ce = 0 by checking 
the dynamics of the system ( [TOl l. ■ 

Remark 1. From Theorem |7] it can be concluded that the 
tracking in formation problem parts into two sub-problems: 
Stabilization Problem and Collision Avoidance Problem, 
stated below. 

Definition 3. Let there be a system as follows 

y = -D^-^y ( 11 ) 


Proof: By Theorem]^ it follows that there always exists 
a diagonal matrix D multiplied with such that all the 
roots of are positive and simple. From the definition 

of stability, if all the roots of are positive, then 

limt_>oo C = 0 with the control law ( [l4| for the system ( |T3] l. 

■ 

We next give an algorithm to find the elements of D 
iteratively using the leading principal minors of the matrix 
Before that we need to define a few quantities. Let the 
matrices D and be partitioned as 


$ 


-r _ 
i+r — 


$ri 


$11 


Di+i — 


Oil 


Oil 

dll 


(15) 


where G (j^i+ixi+i^ ^ j with fn G C (first 

principal minor of $“^) are the n leading principal minors 
of the matrix $ii G $ii G $ii G 

and $11 G The dimensions are similar for the diagonal 

stabilizing matrix I?i+i with Da = diag{di, ...,di} G C®^®. 
We then define another matrix M{di+i) = Di+i$i+i as 


M{di+i) 


ddii^ii Llii$ii 
dii$ii dii^ii 


(16) 


where y G C” the eigenvalues of the matrix $“^ are nonzero. 
Then find a stabilizing matrix D G C®®^®® such that the 
eigenvalues o/Z?$“^ have all positive real parts. Therefore 
limt^o y = 0. 


Then the eigenvalues of the matrix M{di^i) can be calculated 
using the characteristic equation det [A/i+i — M{di+i)\ = 0. 
The characteristic equation for the partitioned matrix M{di+i) 
can be written as 


Definition 4. Let there be a system as follows 

y = -Vf (12) 

where v/ denotes the gradient of a potential function f{y). 
Then find a collision avoidance function f(jj) such that 

limt^o 2/ = 0. 

We first solve the stabilization problem and then solicit the 
collision avoidance problem subsequently. 


A. Stabilization 


In this section we will discuss the Stabilization problem 
and leave the collision avoidance part for the next subsection. 
Hence, we remove Ua from (|^ and apply transformation [] to 
get 




(13) 


Theorem 2. The following controller 

= + (14) 

will stabilize the system ([T31), i.e., limt_j,oo ^ = 0, if there 
exists a diagonal stabilizing matrix D multiplied with $~^ all 
of whose leading principal minors are nonzero. 


The proof requires the following result related to the mul¬ 
tiplicative inverse eigenvalue problem. 


det{XIi+i - 

det{{\ — dii$ii) — dii$ii Da^n) = 0 

using Schur Compliments for partitioned matrices. ini' 
requires that det{XIi+i — Da^u) f 0 which follows 
det{Dii^ii) 0. This complies with the criteria that the 
leading principal minors of the matrix $“^ are nonzero. Note 
that if Da is known, then the eigenvalues of ( [TT] ) can be 
determined solely with the selection of du. 

Next we give an algorithm to find D, in which the notation 
$“^ is used to denote the sub-matrix formed by the first 
i rows and columns of $“^. 

Algorithm 1 

Input; $^\ for i = I, ...,n — 1, with fn. 

Output: Stabilizing matrix D. 

Procedure: 

Select Aj > 0 

Find di from di = 

for i = 1,..., n — 1 do 

Find di+i using ([T7| such that all the eigenvalues of M{di+i) 
are in the open right half of complex plane 

end for 

Construct D = diag{di, ...,dn) 


Theorem 3. [?] Let A be an n x n real matrix all of whose 
leading principal minors are positive. Then there is an n x n 
positive diagonal matrix D such that all the roots of DA are 
positive and simple. 


It is clear from the above algorithm that once di is determined 
then only d 2 is unknown in equation ( [TtI i in the first iteration. 
Hence d 2 can be selected such that all the eigenvalues of 
M{d 2 ) are in the open right half of the complex plane. The 










process will repeat until all di+i are found. One can thus 
conclude that when the matrix satisfies the assumption in 
Theorem Algorithm 1 can always provide a solution D 
without any exemption. 

B. Collision Avoidance 

Before presenting our results on stability, we provide a few 
dehnitions and theorems to facilitate our claim. 

Definition 5. Let there be a linear transformation ^ : z ^ ^ 
between two non-empty configuration spaces z = [zi, Zn] £ 
C" and ^ = [^ 1 , £ C", and its inverse ^ z 

exists. Define Zi = ^n) and = ffizi,z^) for 

i = l,...,n to denote that Xi are linear combination of the 

vectors ^ and are linear combination of the 

vectors zi,...,Zn £ Then the Euclidean distance between 
two points Zi, Zj £ z, dx £ K is defined as follows 

dz=\\ Zij\\= z*jZ,j ( 18 ) 

where Zij = Zi — Zj, (.)* denotes the complex conjugate of a 
complex number and z*j is the complex conjugate of Zij. 

The Euclidean distance can also be expressed as a function 
of ^1, ■■■, C C Therefore write 

dz = d^=\\[f-dr[f-d]\\ (19) 

where f~d = ..., C«) - and d^ refers 

to dz in terms of ^i, £ C 

Remark 2. The Euclidean distances of and are 
equivalent. 

Computation of Potential function in transformed do¬ 
main : Let there be a linear transformation $ : z —^ between 
two non-empty configuration spaces z = [zi,...,z„] £ C" 
and ^ £ C", and its inverse ^ z 

exists. Define Zi = C«) and = /i(zi,..., z„) 

for i = l,...,n to denote that Zi are linear combination of 
the vectors ^ and are linear combination of 

the vectors zi,...,z„ £ x. Then a distance based potential 
function between two points Zi, Zj € z, fiz ^ ^ can be defined 
as 

(l^z = fz{\\ Zi - Zj \\) ( 20 ) 

where || Zi — Zj || denotes the Euclidean distance among the 
agents Zi € x and Zj £ z with i fz j. The potential function fiz 
can also be expressed as a function o/^i, Therefore 
write 

h = m II) (21) 

where (j)^ refers to fiz in terms of ^ and 

II II denotes the Euclidean 

distance as in 

Lemma 1. The potential functions of and 0 are 
equivalent. 

Proof: (Sufficiency). Since by definition, Zi = 

/r^(6,-,Cn) and z^- = then || z^ - z^- || = || 


- fj II- Therefore, /^(|| z, - Zj || 

) = fdW ID- Hence, fiz and 

are equivalent. 

(Necessity). Suppose that fiz and are not equivalent. Then 
there must exist a vector for which z^ ^ ff^{^iT--,^n) which 
is not possible by definition. Thus fiz and are equivalent. 

■ 

Computation of gradient: Let there be a linear transforma¬ 
tion $ : z —^ ^ between two non-empty configuration spaces 
z = [zi,...,z„] £ C" and ^ and its 

inverse ^ z exists. Define Zi = and 

ii = fi{zi,..., Zn) for i = 1,..., n to denote that Zi are linear 
combination of the vectors ^ and are linear 

combination of the vectors zi,...,z„ £ z. Then the gradient 
of a distance based potential function 0 is defined as 

\/ijfiz — S/ij f z{\\ Zi Zj II) (22) 

where || zt — Zj || denotes the Euclidean distance among 
the agents Zi G x and Zj £ x with i fz j_ The gradient of 
potential function SJijfiz can also be expressed as a function 
of ^ 1 , £ C- Therefore write 

yijh=yijfd\\ f~^dl,-,^n) II) (23) 

where S/ijfi^ refers to \/ij4>x in terms ^ and 

II f~^di,—,Cn) - ff^di,—dn) II denotes the Euclidean 
distance as in 0. 

Theorem 4. The gradients of the potential function of ( |22| ) 
and 0 are equivalent. 

Proof: (Sufficieny). Since by definition, 

and Zj = then 

II 11 = 11 - f-\d,-du) 11- 

Therefore, \7^jfz{\\ z^ - Zj ||) = VzjfdW 

ff^{d,-dn) - fi^di,-dn) ID- Hence, and 

are equivalent. 

(Necessity). Suppose that SJijfiz and S/ijfi^ are not equivalent. 
Then there must exist a vector for which Zi fz f~^{^i, ...,^n) 
which is not possible by definition. Thus fiz and cj)^ are 
equivalent. ■ 

Lemma 2. Let X/ijfiz of \22) is defined as 

VtjfziW z^ - Zj id = Pz,^ (z^ - Zj) (24) 

where Pz^j = /zi^dl zi — Zj ||) £ C. Then the total potential 
of an agent Zi & z due to all neighbouring agents Zj Zi G z 
can be defined as 

N 

= X! P^^Jd^-ZJ) (25) 

Then the total potential for agents i = 1, ...,n can be written 
in augmented form as 

= P.z (26) 

where the elements of the matrix Pz, Pij = j^iP^ij- 

then define the total potential in ^ £ C" for i = 1, ...,n in 


augmented form as 


where [see next Theorem], 


(27) 


Proof: The control law of ( [36l l will give the closed loop 
dynamics of (|^. As 0 as t oo, the closed loop 

dynamics of ([^ will reduce to 


Theorem 5. Suppose that there is a system of equations in x 
defined as 

i = - V (28) 


and another system of equations in ^ defined as 

C = - V (29) 

Then ( |28| l and {29) are equivalent under the transformation 

^ : z ^ C 

Proof: By multiplying ( |28| ) with $ and using ( |26l l , we 
get 

^ (30) 

But Pz = P^ by Theorem ??. Also the null space of P^ is the 
same as the null space of Hence, ( |28| l and ( |29| ) are 

equivalent. ■ 

Remark 3. Note that every equilibrium set of system ^9) is 
equal to every equilibrium set of system P8| ), as per Theorem 

m 


Theorem 6. Suppose that there is a system of equations in x 
defined as 

z = -K,z (31) 


ie = -K^^e (37) 

as 0 or 0. Then if the eigenvalues of the matrix 

ATj are in the right half of s-plane, then limt_>oo Ce = 0. ■ 

Suppose that the Jacobi vectors of [] for n = 3 agents are 
given as 


6 = '/JP{Z2 - Zi) 

^ ,— ( miZi+m2Z2\ 

6 = ^3-^- 

\ TOi + m2 / 


^c = 


M 


(38) 


where M = 


ELi ^*+1 


for i = 1,2 


(39) 


The Jacobi vectors can be rewritten as 


and another system of equations in ^ defined as 

i = (32) 

where Then iB and \32) are equivalent 

under the transformation $ : z — 


= OiiZi + 012^2 

^ 2 = 0212 : 1 + 022^2 + 023 - 2:3 (40) 

= OaiZi + 03222 + 03323 


Proof: As the null space of is the same as the null 
space of K^, the two systems and ( [ 3 ^ have the same 
equilibrium set and therefore are equivalent. ■ 

Theorem 7. Suppose that there is a system of equations in z 
defined as 

Ze = —KzZe — PzZ (33) 

and another system of equations in ^ defined as 

E = (34) 

Then ( |33| l and ( |34| l are equivalent under the transformation 

$ : z 

Proof: As the null space of —K^z^ — PzZ is the same as 
the null space of —~ the two systems 

( |33l l and ( |34l i have the same equilibrium set and therefore are 
equivalent. ■ 

Theorem 8. limt_>,oo = 0 for the system 


where on — —pi, 012 — pi, 021 — — ’ ® 2 i — 

023 = s / p ^, O31 = 032 = ^ and 033 = 

Then equation (|40ll can be written in augmented form as 


Cl' 


Oil 012 0 


2l 

C2 

= 

021 022 023 


2:2 

Cc. 


031 032 a33_ 




Hence, the Jacobi Transformation for n = 3 is 


Oil 

012 

0 

021 

022 

023 

031 

032 

033 


(42) 


The vectors in Cartesian Coordinate can be expressed as 


i = u 

with the control law 


(35) 


2l = + Ai 2^2 + ^laCc 

Z2 = ^21^1 + A 22 C 2 + ^23^0 
2:3 = ^31^1 + ^32^2 + ^33^0 


U = -K^^e + 


(36) 


(43) 
















where 
All = 
Ai2 = 


1 012 ^023031 

Oil A 

012033 


Al.i = 


Oil 

O 12 O 23 


O33O21 , 
Oil 


1 ,023031 

A 2 I = - 


A 22 — 


A 31 = 


A 32 — 


‘ 2:2 
O 33 , 

^ 2:2 

1 


Oil 

A 23 = — 


^ 2:2 

033021, 
Oil 

023 

^ 2:2 


A 


2:3 

1 


O31 , 021012^ O21 , 031012, 

-(O22-)-(O32- ) 


Oil 


Oil 


Oil 


Oil 


A 2 


032 — 


031012 


A33 = -^ 
Ax2 ~ O 33 
Ax2 = O 23 


1 


O 22 — 


Oil 

02l0i2\ 


O22 — 


O32 — 


Oil 
02l0l2 \ 
On } 
03l0l2 \ 
On ) 


— 023 032 — 


— 033 022 — 


031012 \ 
On } 

02l0l2 \ 

On / 


Then equation (|43]l can be written is augmented form 


2:1 


All Ai2 Ai 3 


cr 

■Z2 

= 

A21 A22 A23 


C2 

^3. 


_A3i A32 A33_ 




Hence the inverse of Jacobi Transformation is 

An Ai2 Ai3 
A 21 A 22 A 23 


$-1 = 


A31 

Let us choose a potential function of [] as 

- ^2 IP 


Vij{zi, Zj) = min I 0, 


Zi — Zj 


-B? 


(44) 


(45) 


(46) 


(47) 


where R > r > 0. zi^Zj denotes the position of robots and 
Vij{zi, Zj) denotes the potential function of Zi with respect to 
the neighbouring robot zj. R denotes the radius of detection 
and r is the avoidance radius. Denote Zij = Zi — Zj. Then the 
gradient of the potential function with respect to Zij is 


dv. 




0, 

Pz,, {Zi - Zj), 

not defined, 

. 0 , 


Zi - Zj ||> R 


if ,, 

if i? >11 Xi — X 

if II Zi - Zi 11= r 


1 ll> -r 


(48) 


where 


= 4 


(R^-r 


‘‘J 
^-R^) 


2-r2) 


2tT- 


Denote 


fi{zi,Z 2 ,Zc) and Xj = fj{zi,Z 2 ,Zc). For brevity, we write fi 
and fj to denote fi{zi, Z 2 , Zc) and fj{zi,Z 2 ,Zc) respectively. 

Define = fi - fj. Then = 4^— (||/2^^||2_^2)3 —A 

From the collision avoidance law for agent 


n r-. 

E UVij 

rp . . 

3 = 1 . 3 ^^ 


( 49 ) 


we have the following control laws for n = 3 agents 


Ual = (p/12 +F/i 3)^1 - P/1222 - P/13 ^^3 

Ua2 = -Phi Zl + (p /23 + Phl)z2 - Ph3 23 (50) 

Ua3 = -PhiZl - P/32 ^2 + (p/31 +P/32)23 


The equation (|50ll can be written in augmented form as 


Ual 


(P/12 +P/13) 

-P/12 

Ua2 

= 

-Phi 

(P/23 +P/21) 

Ua3_ 


-Phi 

—P/32 


Then we write 

Ua = PfZ 


-P/13 


Zl 

—Pha 


Z 2 

(p/31 +P/32). 


^ 3 . 


(5iy 


(52) 


where 


Pf 


(P/12 +P/13) 

-Phi 

-Phi 


—Pfl2 —P/13 

iPha 4 ” P/21) P/23 

—Pf 32 (P/31 4 " P/32). 


We write 

Ua =P/4>"^C 


(53) 


(54) 


Note that Ua = f{f)- Next we define the potential function in 
transformed domain as 


U^a = ^P/^* = Pif (55) 

where p^ = $p/4>“^. Note that = fi{zi, ...,Zn). Therefore 
the summation of the gradient of the potential functions with 
fi must associate the linear combination of the potentials due 
to Zl,..., z„ G z as in obviously, represented in terms of 
Cl, ...,Cra G f. 


C. Double integrator dynamics 

Suppose that each agent is driven by a double-integrator 
dynamics 

Zi = Vfi (56) 

where the position Zi G C and the velocity Zi G C are the 
states, and the acceleration Vfi G C is the control input. Then 
the combined dynamics of ( |56] l can be written as 

z = vf (57) 

where z = [zi,..., Zn]'^ G C" and Vf = [vfi ,..., u/„]'^ G C". 

Consider that system ( [57] i is driven by the following control 
law 

Vf — KpZ^ KyZ^ Zd (58) 

where Kp,Ky G C"^” are the controller gains and Zg = 
z - Zd G C", with Zd = [zdi,...,Zd 2 ]'^ G C”, and Zdi = 
Zdxi 4- tXdyi G C is the desired trajectory given to the 
agent to follow. Then the overall closed loop system of double 
integrators can be written in the following compact form 

Zg — TTpZg KyZ^ (59) 

Applying transformation Q in ( |58| l we get 

fe — 


(60) 









































where Kp^ = ^Kp^~^ and Let Kp = 

and Ky = ^~^D 2 . Then the combined system of 
(|60ll can be written in matrix form as 




0 

I 



. 1 . 



-D2<i>-\ 


.i 


Theorem 9. Let there be a complex transformation $ : z —^ 
and its inverse exists. Also the leading principal minors o/$“^ 
are nonzero. Then there exist two diagonal stabilizing matrices 
Di and D 2 for the system •HD- 


Proof: Denote 


A = 




(62) 


Let [x ^be the right eigenvector of A. We then have 


A 

X 

= X 

X 


y. 


y. 


where Ai is an eigenvalue of A corresponding to the eigen¬ 
vector [x^. (| 6 ^ implies the following equations 


II 

(64) 

-i9i$ ^x-D 2^ = XiU 

(65) 

Using (|64||, (|65|) is written as 


—Di^~^x — XiD2^~^x = X^x 

( 66 ) 

The matrices Di^~^ and D 2 ^~^ share same 

set of eigen- 


vector X and is therefore simultaneously diagonalizable. Let 
Di^~^x = CTiio; and D 2 ^~^x = a 2 iX, where an and a 2 i 
are complex eigenvalues of the matrices Di^~^ and D 2 ^~^. 
Since Di^~^ and are simultaneously diagonalizable 

the following is true 


<J2i = ICTli (67) 

Replacing ( [hT] ) to get 

-aiiX - -faiiXiX = \}x ( 68 ) 

From ( | 68 l l, we have the following second order characteristic 
polynomial 

•Y. + + CTii =0 (69) 


Thus to show the existence of stabilizing matrices Di and 
D 2 , it remains to show that n) can be assigned such 

that the roots of the complex coefficient characteristic equation 
( | 68 | l have negative real parts. 

Define ai = 02 = Re{aii) and 61 = 62 = Im{aii). Then 
from a second order polynomial with complex coefficients 
can be written as follows 


F 2 {X) = + {a^+ibi)X + {a 2 +ib 2 ) (70) 

By Theorem2 of 123 , @ is stable if and only if the 
following polynomial of order 1 is stable 

Fi{X) = aiX +aial + blb2 + ib2 (71) 


where bl = aibi — 62 and = 0102 . Then the root of Fi(X) 
in is as follows 


A = - 


0^02 + (aibi - 62)62 


ai 


h 

ai 


(72) 


The real part of the root in ( |72| > holds the following inequality 
for ( [TT] ) to be stable 

0^02 + 016162 — 62 


Oi 


> 0 


(73) 


where oi > 0. Replacing 01 , 02 , 61,62 we get the following 
condition for the existence of Di and D 2 and to prove the 
theorem 


_ Re{aii)^ _ 

/m((Jii)2[l - iie(CTij)] ^ 72 


(74) 


Remark 4. Under the assumption of and the condition 
there exist Di and D 2 such that system is stable. 
Therefore it is sufficient to find a Di, as the eigenvalues of 
D 2 are just a scalar multiple of the eigenvalues of Dy. 

From the proof of Theorem 9, we find that stabilizing 
matrices Di and D 2 can be found from for double-integrator 
dynamics including the condition ( |74| ) in the Algorithm 1. 
We present it below. 

Algorithm 2 

Input; <i)^\ for i = 1,..., n — 1, with fin. 

Output; Stabilizing matrix Di and D 2 . 

Procedure; 

Select Ai > 0 

Find di from di = -Y- 

for i = 1, ..., n — 1 do 

Find di+i using ([T7| such that all the eigenvalues of M(di+i) 
are in the open right half of complex plane 

end for 

Select a D that satisfies the condition ( |74l i 
Construct D = diag{di ,..., d„) 

Choose a scalar 7 

Construct Di = D and D 2 = yD 


Theorem 10. Apply the transformation (|3) on to get the 
following system 

e = v^f (75) 

Then the following control law 

V^f = - D2<S>-Ye + id (76) 

will stabilize the system cn. if there exist two diagonal 
stabilizing matrices Di and D 2 for all of whose leading 

principal minors are nonzero. 

Proof: From Theorem 9, it can be checked that under the 
condition stated in (|74|i, there exist stabilizing matrices Di and 




















D 2 such that all of the eigenvalues of A lies in left half of 
complex plane. Therefore the proposed control law ( [76l l will 

stabilize the system ■ 

Theorem 11. limi_>.oo Ce = 0/or the system 

i = u ill) 

with the control law 

u = (78) 

Proof: The control law of ( |78| ) will give the closed loop 
dynamics of ( [59| ). As 0 as f —oo, the closed loop 

dynamics of (|59|) will reduce to 


where, pi = 




(79) 



The simulations are carried out on 6 agents with single 
integrator kinematics of real and complex dynamics. The 
details of each simulation is given in the following subsections. 
The Jacobi vectors of 6 agents of real and complex dynamics 
HI) are given below 

= pi(a ;2 - xi ) ; ^2 = ^^2(2:3 - ^(2^1 + 2 ; 2 )] 


6 = Psixi - -(2;+a:2 +2:3)] 

^4 = P 4{ x 5 - ^{xi + 2:2 + X3 + 2:4)] 

Cs = ~ 7(2^1 + 2:2 + 2^3 + 2:4 + Xs)] 

5 

= T (2:1 + 2^2 + trs + 2:4 + 2:5 + 2:6) 

6 


(80) 


1 ,, _ y5 ,, — y)3 ,, _ ^ ,, _ VE 

V2’ ^2 - ^3. Ms - 2 ’ ^^4 - yg, Pd - yg- 

Consider a planner formation with a formation basis defined 
as Zd = a[(-l,0), (-|,^), (|,^), (1,0), 
(—1,—^)]^ for a equilateral hexagon of side a. Note that 
the scaling coefficient for a planner formation a could be 
either constant or time varying, e.g., a = Bsin{ujt). In 
the transformed domain the formation basis is defined as 
- where, ^sd = = ^sZd with 

as follows 


^d = 


sd-> ‘ 
$ = $ 


TlT 


$ = 






as 0 or 0. Then if the eigenvalues of the matrix 

Kp^ = and Kp^ = are selected by choosing 

Di and D 2 as per the condition stated in Theorem 10, such 
that the eigenvalues of matrix A of ( |6T] ) lie in the left half 
of s-plane, then the control law ( |78] l will stabilize the system 

O ■ 

IV. Simulation Results 



(81) 


Ccd = t + isint is the desired trajectory of the cen¬ 
troid. It can be checked that the leading principle minors 
of are nonzero and the eigenvalues are not all pos¬ 
itive. Then, by theorem, there exists a stabilizing matrix 
D = [-1.4140 - 1.41401,-2.4498 -f 2.4498t,-4.6189 - 
2.3095t, -3.7244-f 1.8622(,, -1.6117t, 0.0340]^ such that the 
eigenvalues of have positive real parts. Therefore the 6 

agents asymptotically reach the given)] planner formation. A 
simulation of a moving formation with 6 agents is shown in 
Fig. 



Fig. 2 . Schematic representation of multiple groups of robots 


V. Conclusion 

This paper addresses two different aspects of planner forma¬ 
tion for a set of complex single integrator systems. Therefore 
the dimension of the system reduces to half. The first problem 
is a stabilization problem associated with a real linear trans¬ 
formation and the second one is to find a sophisticated way to 
carry out stability analysis in the transformed domain for the 
system subjected to collision avoidance. Instead of choosing 
the gain directly, we write the system of equations in the 
transformed domain such that the inverse of transformation 























Fig. 3. Schematic representation of multiple groups of robots 


appears in the closed loop dynamics. This way the stabilization 
problem is formulated. The inverse of transformation must 
have nonzero eigenvalues with both positive and negative real 
parts. This may lead to instability of the system. Therefore, 
the inverse of transformation is pre-multiplied by a diagonal 
stabilizing matrix so that all the eigenvalues of the product is 
reassigned with positive real parts. Hence the system becomes 
stable. Then we define matrix of potential and formulate a 
matrix of potential in the transformed domain using the matrix 
of potential in actual domain to get the same effect of collision 
avoidance in the transformed domain. This means that we give 
the structure of collision avoidance controller in the trans¬ 
formed domain. Therefore we do not need to add the collision 
avoidance controller going back to the actual domain from the 
transformed domain after designing a stabilizing controller in 
the transformed domain. We provided a systematic way to find 
a diagonal stabilizing matrix. Simulation results are given to 
support our claim. 
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